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Project Conclusions 


Research results of this grant (NAG- 1-1397) entitled ROBUST STABILITY OF 
SECOND-ORDER SYSTEMS sponsored by NASA Langley Research Center are included 
in the following four papers: 

1. "Controller Designs for Positive Real Second-Order Systems," Proceedings of 1st 
International Conf. on Motion and Vibration Control, Yokohama, September 1992. 

2. "A Robust Controller for Second-Order Systems using Acceleration Measurements," 
Proceedings of AIAA Guidance, Navigation and Control Conference, Monterey, August 
1993. 

3. "A Passivity Based Controller for Free Base Manipulator," Proceedings of AIAA 
Guidance, Navigation and Control Conference, Monterey, August 1993. 

4. "Nonlinear Control of Space Manipulators with Model Uncertainty," Proceedings of 
AIAA Guidance, Navigation and Control Conference, Scottsdale, August 1994. 

The four papers have been published in the conference proceedings as indicated 
above and they are either in the review process or to be submitted for technical journal 
publication. The objectives of this project have been demonstrated in the four papers. 

In the paper "Controller Designs for Positive Real Second-Order Systems," 
necessary and sufficient conditions for positive realness of second-order SISO systems 
have been derived. For the MIMO case, two designs using different choices of output 
variables have been presented for the system without velocity output. And a possible 
control method for such systems has been examined, illustrated by the simple example. 

The paper "A Robust Controller for Second-Order Systems using Acceleration 
Measurements" presented an interesting practical control method. Only acceleration at 
certain locations of the system needs to be measured by using common available 
accelerometers. The design is model independent and no knowledge of the constants of the 
dynamic system is required. Any strictly positive real controller can be used. Thus it is 
possible to choose one that yields a satisfactory transient response. 

In the paper "A Passivity Based Controller for Free Base Manipulator," a control 
method based on feedback linearization and passivity concepts that was proposed earlier for 
fixed base robots is modified and extended to the case of space robots. The control law 
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results in asymptotic joint angle tracking in the face of bounded uncertainties. For the first 
time, closed-loop simulation results are presented using this control method. For the one 
link and two link manipulator examples illustrated in the paper, the control method shows 
promising results. Specifically, it was shown that significant simplifications to the 
nominally complex feedback linearization controller are possible when the proposed robust 
control method is used for synthesis. 

In the paper "Nonlinear Control of Space Manipulators with Model Uncertainty," a 
nonlinear dynamic model was obtained for space manipulators with uncontrolled base. A 
robust control method based on feedback linearization and passivity concepts was proposed 
for space manipulators. The method is applicable to fixed base manipulators as well. The 
control law results in asymptotic joint angle tracking in the face of bounded uncertainties 
such as those due to imprecise friction modeling. 

Further research is needed to extend the robust stability results of this study to a 
commercial application. Structure damage is a crucial problem of public safety. The robust 
stability feature ensures that an installation of active controllers will always improve the 
safety and performance. If the controllers of this study are validated by experiments, 
transfer of this robust stability technology to commercial sectors will be accelerated. 
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CONTROLLER DESIGNS FOR POSITIVE REAL SECOND-ORDER SYSTEMS 


C-H. Chuang, Olivier Courouge, and J. N. Juang 
Georgia Institute of Technology, Atlanta, GA 30332, USA. 


ABSTRACT 

It has been shown recently in [1, 2] how virtual passive controllers can be designed for second-order dynamic systems to 
achieve robust stability. The virtual controllers were visualized as systems made up of spring, mass and damping elements. In this 
paper, a new approach emphasizing on the notion of positive realness to the same second-order dynamic systems is used. 
Necessary and sufficient conditions for positive realness are presented for scalar spring-mass-dashpot systems. For multi-input 
multi -output systems, we show how a mass-spring-dashpot system can be made positive real by properly choosing its output 
variables. In particular, sufficient conditions are shown for the system without output velocity. Furthermore, if velocity cannot be 
measured then the system parameters must be precise to keep the system positive real. In practice, system parameters are not 
always constant and cannot be measured precisely. Therefore, in order to be useful positive real systems must be robust to some 
degrees. This can be achieved with the design presented in this paper. 

KEY WORDS: positive real, second-order system, multivariable system, controller design 

1. INTRODUCTION 

The concept of positive realness was first used in network theory. A function that can realized as the driving point 
impedance of a passive network is called positive real (PR). In general, a linear system is called positive real (PR) when it is 
possible to define an energy term that is not generated within the system. PR systems have many important applications in control 
theory; however, much attention has been paid in the literature for finding criteria for positive realness of linear systems (see [3]). 
PR systems have also been used for shape control of Urge flexible structures. Nevertheless, positive realness of multivariable 
second-order systems was never studied in details. For most PR designs in the literature, the output of the plant is usually a vector 
of velocity sensors collocated with a set of points actuators. 

In this paper, we use a more general approach for PR systems and present several possible PR designs. First we review basic 
definitions and theorems and clarify the physical meaning of positive realness. Then we find necessary and sufficient conditions for 
positive realness of single-input single-output spring-mass-dashpot systems. For multi-input multi-output systems, the Kalman- 
Yakubovitch Lemma is used to find sufficient conditions. The sufficient conditions state that given a spring-mass-dashpot system it 
is possible to define an output variable which will make the system PR. Since certain variables of the system may not be always 
measurable, we consider the positive realness under restrictions of available measurements. With uncertainty in the system 
parameters the positive realness of a system without velocity output will not hold anymore. In this case we present a design method 
using a feed-forward loop to achieve positive realness. The robustness of a general positive real second-order system can thus be 
achieved by using this method. Finally, the design method is demonstrated in a simple example. 

2. REVIEW OF DEFINITIONS AND THEOREMS 
2.3 Positive Real Systems 

Definition 1 [5]: An nxn matrix is called positive real if it satisfies all the following conditions: 

1. G(s) is real rational. 

2. G(s) is analytic in Re(s)>0. 

3. Poles of G(s) on the imaginary axis are simple and the residues of these poles are Hermitian and positive semi- 

definite. 

4. G0o))+G*(jw) * 0 for all real co. 

The above definition does not have any physical interpretation. Another definition of PR systems is given in the time 
domain, which uses the concept of passivity and allows a physical interpretation of positive realness. This definition is show n in 
the following. 

Definition 2 [5]: Let a linear time-invariant system have the a minimum state space representation (A,B,C,D). Lei u be an 
mxi control vector, y be an mxl observation vector, and x be an nxl state vector. Then the system is passive if and only if there 

exist two functions £(*) and X(x,u) such that the scalar product of input with output can be expressed for all t £ 1 0 by 

y T u dt * [$(x ))!,', + J X(x, u)dt ( 1 ) 


with X(x,u)20 for all x and u. 

Remark 1: y T u is the external power input and • X(x,u) is the internal power generation. Equation (2) indicates that the 
variation of stored energy is equal to the external energy input plus the internal energy generation. Since X(x,u) £ 0, the internal 
power generation is always negative and so is the internal energy generation at any time t. As a consequence, passive systems are 
systems that do not generate energy. Nevertheless, the energy will not always have a physical interpretation. In the above 
definition £(x) can be any function of x, and it may not have any obvious physical meaning. 

The following theorem states a relationship between linear PR systems and passive systems. 

Theorem 1 [5]: Consider a time-invariant linear system with transfer matrix G(s). G($) is positive real if and only if the 
system is passive. 

Hence positive real linear systems are linear systems for which the energy is not internally generated by the system. Positive 
real matrices can also be characterized in the time domain by using the following Kalman-Yakubovich Lemma. 
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Theorem 2. Kalman -Yakubovich (K-Y) Lemma [5]: Let G(s) be an nxn real rational matrix, with G(~)<~. Let (A,B,C,D) 
be a minimum realization of G(s). Then G(s) is positive real if and only if there exist real matrices P, Q, R and S such that: 

PA+A t P*-Q, B t P + S t *C, D + D t «R (2) 


Q s 

where P > 0 and T 

Ls R 

2.2 Strictly Positive Real Systems 

Definition 3 [5]: An nxn matrix G(s) is strictly positive real (SPR) if there exists a positive number e such that H(s-c) is 
positive real. 

A system with a strictly positive transfer matrix will be called SPR. In practice, SPR systems are systems that dissipate 
energy. For such systems, the internal energy generation is strictly negative whenever there exists a non-zero external energy input. 
Therefore SPR systems are sometimes called dissipative systems. However, the concept of dissipativeness can also be applied to 
nonlinear systems. Hence SPR systems are dissipative, but the converse is not true. The two notions are equivalent only for the 
linear time invariant case. 

3. NECESSARY AND SUFFICIENT CONDITIONS FOR POSITIVE REALNESS OF SECOND-ORDER SCALAR SYSTEMS 

Here we derive necessary and sufficient conditions for the positive realness of scalar second-order scalar systems. 

Theorem 3 : A scalar second-order system described by 

mx + cx + kx = u and y = h,x + h v x + h d x (3) 

is PR if and only if 

(i) h, £ 0,h w £ 0, h 4 2 0 and (n^mh* -^kh t |s^ch7 (4) 



Proof: The transfer function of the system in Eq.(3) is 


G(s) = 


h,s 2 +h v s+ h,. 

A 

ms + cs + k 


(5) 


Conditions 1 and 2 are satisfied. Conditions 3 and 4 are checked in the following. Rewrite Eq.(5): 
Re[G(jo>)] * |mh,o 4 + (-mh^ + ch v - kh, )a> 2 + kh< } / j(k - mco 2 ) 2 + c 2 w 2 } 

- L L* + +ch„-kh,)j* _ (-mh,+ch.-kh.)» 

( *[ 2mh, J 4mh, ' 


(6) 


/ {(k - mio J ) J + c s ( 0 J } 


Re[G(jo))] approaches h a /m when u approaches infinity. Hence h,*0. For <o*0, we obtain h d £0. Thus we have the following two 
cases: 


(a) h, £0, h d £0,and(-mh, +ch v - kh,)£0 

(b) h, £0,h rf 2 0,and(-mh 4 + ch v -kh,)£0 ' } 

For Case (a), Equation (6) is positive as seen from the first expression of (6). Note that since ch v £mh d +kh lt we obtain ch v *0 

which implies hy^O. Furthermore, we have V ch v *^inh7+ kh, . Few Case (b), since the square term of the numerator can be made 
equal to zero, we need to check the following inequality: 


(-mh d + ch v - kh,) 2 
4mh, 


+ kh 4 *0 


( 8 ) 


that is (^mh d --^kh, ) 2 Sch v £mh d + kh,. From the left inequality we have ch v £0, which implies h v 20. Now taking the square 
roots of the inequality yields 

| V*n"hd - V th . | * * V mh d + (9) 


Combining both cases, we have (i) and (ii) of (4). * 

The poles of G are the solutions of the equation ms 2 +cs+k«0. Double imaginary poles are only possible if c=0 and k=0. 
However, from (9) we have h d *0. Therefore, the zero pole is simple. As a conclusion, G has no double pole on the imaginary axis. 
Now it remains to show that the residues of the imaginary poles are real and positive. If k * 0, then the residue of the pole at zero 
is h v /m, which is real and positive. If k*0, G(s) has some poles on the imaginary axis only when c=0. The poles are 
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jVk / m and - j>/k /m . The residue for the both poles is 


Re s = 


mh v j, 
m (2mj 


k 
TiT 



( 10 ) 


which is real and positive. Hence the theorem is proved. 


4. SUFFICIENT CONDITIONS FOR POSITIVE REALNESS OF SECOND-ORDER MULTIVARIABLE SYSTEMS 

In general, a second-order MIMO system can be made positive real by properly choosing the output variables. For the 
system with velocity and displacement output, a sufficient condition of the positive realness is the collocation of the both outputs 
with the controller. Moreover, if only velocity output is available, the collocated system is still positive real. The velocity is an 
important factor of making the system positive real. For example, if only displacement output is available then the system cannot 
be made positive real. In some space applications, velocity is the most difficult measurement to obtain. Here we discuss conditions 
for which the system without velocity output can be made positive real. 

4.1 Acceleration and Displacement Output 

Consider a system represented by 

Mx + Dx + Kx = Bu and y * H g x + H d x (11) 


Assume rank(B)=m, and let L=B(B T B)' 1 . Furthermore, define H] *LH t and H* « LH and let P be the 2m x 2m matrix 


h; t m h; t k 
h; t m h; t k 


( 12 ) 


Theorem 4 : If P£0, then the system is positive real. 

Proof: The input-output scalar product can be expressed as 

y T u = y T L T Bu = (Ly) T (Bu) 


- Therefore, 


y T u = (Hjx + H^x) t (Mx + Dx + Kx) 

= (JO + H;x) t Dx + (Hlx + H;x) t (Mx + Kx) 


= i— ( x t h; t Dx + x t h7Dx) + (x T 
2 dt 



03 ) 


( 14 ) 


Therefore, we can define k(X, u) = (x T x T ) P J. If P is positive semi-definite, then X(X,u) is positive for ever) X and every 
u, and hence the system is positive real. 

Remark 2: If rank(B)<m, a new input vector u of smaller dimension can be defined, and this input will be such that the new 
matrix B will have rank m. Thus Theorem 4 can be applied in general cases. 

The following theorem can be applied to make P positive semidefinite. 

Theorem 5 : P is positive definite if and only if 

B(B t B)-’ H.M’ 1 * 0 and H, = H,M~‘K (15) 

Proof: Assume that P is positive semi-definite. Since M is nonsingular, there exists a positive real number k such that the matrix 
H' + kM is non-singular. For such a k assume that the matrix EcK - M(H|+ kM) 1 (H* + kK) is not equal to zero. Then 
there exists a vector x 2 such that Ex 2 is not zero. Define x^-fH’ + kM) ^H' + kKJx . As a consequence, if 
X.(*J x 2 ) T , we have X T p X = -k ||Mx | + Kx jj* = - k|[E xj^ which is strictly negative. This is impossible. As a 
consequence, E must be equal to zero , i.e. K=M(H*4kM) *(H*+kK). Multiplying through this equality by 
(H* + lcM)M"‘ yields H',M~'K = H*. Thus, 


592 


(*; p 


(:;)■ 


(MXj *f Kx 2 ) M‘ H t (Mx, + Kx 2 ) 


(16) 


Since xi and x 2 can be chosen arbitrarily, another necessary condition is that the matrix be positive semidefmite. 

Hence necessary conditions for positive semidefiniteness of P are 

iOand H; - H*M“ J K (17) 

Those two conditions are dearly also sufficient conditions. Conditions (17) can be rewritten using the initial matrices: 

B(B t B)“ , H # NT 1 2 0 and H* = H.M^K (18) 


Combining Theorems 4 and 5 leads to the following theorem. 

Theorem 6 : If conditions (18) are satisfied, then the system represented by Equations (11) is positive real. 

Remark 3: The conditions stated in Theorem 6 are necessary and sufficient in the scalar case. They can be compared to 
conditions (4) with h v «0. 

4.2 Displacement Output with Feed-Forward Loop 

In Theorem 6 if no exact values of the matrices M and K are known, then the theorem cannot be implemented. In Lhis case 
the following theorem can be used instead. 

Theorem 7 : Assume that the system is represented by 

Mx + Dx + KxeBuand y = H d x + J u (19) 

where K > 0, D > 0, and J is an m x m matrix. Then there exists a positive real number r\ such that the system is positive real 
when 


H, ■ a 2 B T and J = fl B T B 


( 20 ) 


with a 2 >i) and bia* / 2. 

Proof: The idea here is that u is a function of Mx + Dx + Kx . Therefore u includes information on the velocity x and adding u to 
the system output makes the system positive real. Furthermore, the input u is measurable in many applications. The system is 
represented by the following equations: 


X* AX 4 BjU 
Y-CX+Du 


( 21 ) 


0 I 1 r 0 ] [Q 

where A * LB,* ,C>|H 01 and D * J . Here we use the K-Y Lemma. To make T 

L-M 'K -M 'dJ * LM *Bj l * J ,s 

T 

positive semi-definite, let us choose Q2I and R2SS . Let Pj»a 2 K+a 3 D, P 2 *a 2 M and P 3 *a 3 M. This yields 


Si 

rJ 


Q 


'2a 3 K 

0 


0 1 

2a 2 D-2a 3 MJ 


( 22 ) 


Since K>0, there exists a £=$(K) such that a 3 >$ which implies Q)*2a 3 K2l. For a 3 «a 3o >t' as D > 0, there also exists a positive 
number 7i 0 (a3,D,M) such that a 2 2qo which implies Q2*2a2D-2a 3 M£l.. Therefore Q2I.. Now we want to have R «D+D T 2SS T . Let 


s«c t -pb 2 



(23) 


Let » a 3 B t . Then S T S = cl*B T B. Therefore, we must have D + D T *a 2 B T B. Select D = p B T B and p such that 

D + D T = 2pB T Biaj B T B . This is satisfied whenever 0 £ a* / 2 . Finally P must be positive definite. Since M>0, we can 
find a positive number tj j(a 3 Q,M,K t D) such that o 2 >Tij which implies P>0. To finish the proof, let Tt*maxCn 0) T}i), 

5. CONTROL OF POSITIVE REAL SECOND-ORDER SYSTEMS 
Consider the following feedback control scheme for the plant 
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It is easy to show that the closed-loop is positive real if C and C are positive real. Hence the closed-loop system is stable, but not 
necessarily strictly stable. Its transfer matrix may have some poles on the imaginary axis. As a consequence, the output of the 
system will not necessarily converge to zero when u«0. If the systems G and C are strictly positive real, the closed-loop system is 
strictly positive real and therefore strictly stable. In this case y will go to zero when t gets large. Still this result is, not very useful 
in practise since it might not be possible to make the plant G strictly positive real in a real application. A very interesting theorem 
stated in [4] is the following. 

Theorem 8 [4] : If in the feedback system of Fig. 1 G(s) and C(s) are square transfer matrices, then the closed-loop system is 
asymptotically stable in the input/output sense if G is PR and if C is SPR. 

Our control objective is to have lim x * 0 when u=0. With a certain class of controllers, it can be proved that this objective is 

i •• 

achieved. This result is stated in the following theorem. 

Theorem 9 : If the transfer matrix of the controller is constant and positive definite, then lim x = 0 when u=0. 

t -♦ — 

Proof; The system is represented by the following equations: 

(M + BCH a )x + (D + BCH v )x + (K + BCH d )x = Bu 
' y«H,x + H,x + H,x (24) 


Let 


M + BCH D - D + BCH , and K * K + BCH, 
The representation of the plant with first-order dynamic equations is now 


{ 


X * AX + Bu 
y*CX+Du 


(25) 


(26) 


where X= 


f*l # and A= ... . . . . . M* will always be non-singular when the output of the system 

L-M *K -M '*D J 


to be 


controlled is designed with the method in Section 4. Furthermore, this representation will be minimal for our applications. If u=0, 
we have X * AX . Since the system is stable, all the eigenvalues of A have strictly negative real parts. As a consequence, 

lim X=0. This means that lim x « 0 and lim x * 0 . 

t -» ■■ t -* •• t -* •* 

6. EXAMPLE 

Consider spring-mass-dashpot system shown in Fig.2. 


The system is governed by: 


A 




m 


i 


Fig.2 



mx + dx *+ kx = u (27) 

The parameters m, k and d are not known precisely. Assume that 2SmS4, 4<d<6 and l<k<3. We will design an output y that 
makes the system positive real regardless of the uncertainty on its parameters. Theorem 7 can be used here, since m, d and k are 
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always strictly positive. First 2 a 3 k £ 1 must be chosen. If a 3 2r 1 / ( 2k » in ) . then this condition will be satisfied for kc [1 , 3) . 
Let a s = I / 2 . Next we want to have a 2 d St (m + 1) / 2 .If a 2 * (m BW + 1) / (2d min > , then this condition will be satisfied 
for me [2, 4] and de [4, 6} . Hence we select o 2 £5/8. Now the other condition is 
a 2 k £ a 2 m 2 - a 3 d, i. e. a 2 £ (m 2 -2d) / (4k) . This condition is satisfied if a 2 * (m 2 ,, - 2d j|| J / (4k mio ) . Since 

o 

(m 2 „ * 2d mjl } / * -y = 2 , this condition is reduced to a 2 £2. Therefore, a general constraint on a 2 is a 2 £2. A possible 

choice is a 2 =2. Finally a number p £ a 2 / 2 must be chosen, p « 2 is a possible choice. As a conclusion, the output of the 

system is y=2x+2u. The system is robustly positive real with this choice. Any constant controller will stabilize the state x of the 
system. 

7. CONCLUSIONS 

In this paper, necessary and sufficient conditions for positive realness of second-order S1SO systems have been derived. In 
the M3MO case, two designs using different choices of output variables have been presented for the system without velocity output 
Finally a possible control method for such systems has been examined, illustrated by the simple example. 
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ABSTRACT 

* 

This paper presents a robust control design using strictly 
positive realness for second-order dynamic systems. The 
robust strictly positive real controller allows the system to 
be stabilized with only acceleration measurements. An 
important property of this design is that stabilization of the 
system is independent of the system parameters. The control 
design connects a virtual system to the given plant. The 
combined system is positive real regardless of system 
parameter uncertainty. Then any strictly positive real 
controllers can be used to achieve robust stability. A spring- 
mass system example and its computer simulations are 
presented to demonstrate this controller design. Robust 
performance property of this design is also demonstrated in a 
simple example. 

1. INTRODUCTION 

Positive real (PR) systems have many applications for 
shape and vibration control of large flexible structures. In 
most of those PR designs, the output of the plant is usually 
assumed to include velocity, and the sensors are assume to 
be collocated with the actuators. In [1], position and velocity 
feedback are used together to control large space structures, 
and the controllers are strictly positive real. PR feedback 
with velocity measurement is examined in [2] for control of 
a flutter mode. [3] presents a robust multivariable control of 
structures using a passive controller in which the velocity 
sensors are collocated with the control actuators. Several 
passive control designs using acceleration, velocity and 
position measurements are presented in [4]. [5] generalizes 
the designs in [4] to handle nonlinear systems. The method 
presented in [6] uses displacement sensors. Similarly, [7] 
examines direct position plus velocity feedback. A 
feedforward positive real design can be seen from [1 1], 

Nevertheless, in some application areas, only 
acceleration is directly measurable. Even though velocity and 
position can be obtained by integrating the measured 
acceleration, exact initial values of velocity and position are 
needed to achieve asymptotic stability. The bias in 
acceleration measurement can also decreases the integration 
accuracy. In this study we develop a virtual system which is 
connected to a strictly positive real (SPR) controller for 


multivariable second-order system when only acceleration is 
directly measurable. Although integration is carried out in 
the virtual system, initial values of the the states of the 
virtual system can be arbitrary and the closed-loop system is 
asymptotically stable. Furthermore, the bias in acceleration 
measurement can be scaled down by the system matrix of 
the virtual system. Since any SPR controllers can be 
connected to the virtual system, the controller design here is 
different from an integral control. 

In this paper, we review some definitions and a theorem 
associated with dissipativeness and passivity. 
Dissipativeness and passivity are then related to strictly 
positive realness and positive realness. Using these 
backgrounds we develop a virtual system to compute an 
output which will make the combined system of the plant 
with the virtual system positive real. The inputs to the 
virtual system are only acceleration and the control force 
applied to the plant. More important, the virtual system is 
model independent, and thus the global system is robustly 
positive real. Therefore an input/output controller can be 
constructed by using any strictly positive real controllers. 
When the stiffness matrix of the second-order system is 
positive definite, we show that it is possible to stabilize the 
displacement if the actuators are properly located. With this 
design, the displacement is globally asymptotically stable. 
A spring-mass example with three masses and no damping 
is used to illustrate our design method. Robust performance 
is demonstrated for a spring-mass system with only one 
mass and one spring. Computer simulations are also 
presented. 

2. PRELIMINARIES 

The concept of dissipativeness describes an important 
input-ouput property of dynamical systems. Consider a 
system with input u and output y, where u is an mxl vector 
and y is a pxl vector. A supply rate for the system is 
defined as follows. 

Definition 1 [8]: A supply rate is a real function of u 
and y defined as 

w(u,y) = y T Qy + 2y T Su + u T Ru (1) 
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where Q, S, and R are any constant real matrices with 
dimensions pxp, pxm and mxm respectively. and 


Q and R are usually symmetric matrices, and w(u,y) is 
often called the input energy into the system. 
Dissipativeness is defined with respect to the supply rate 
w(u,y) in the following definition. 

Definition 2 [8]: The system with input u and output y 
is called dissipative with respdct to the supply rate w(u,y) if 
for all locally integrable u(t) and all T£t 0 , we have 


m=o 


such that 

(i) V T 0(x)f(x) = -l T (x)l(x) 

(ii) ±G T (x)?<Kx)=h(x)-W T (x)l(x) 

(iii) J(x)+J T (x) = W T (x)W(x), VxeR® 


( 6 ) 


(7) 


J*w(t)dt£0 


(2) Moreover, if J (x) is a constant matrix, then W(x) may be 
taken to be constant. 


where x(tQ>=0 and where w(t)*w(u(t),y(t)) which is 
evaluated along the trajectory of the system interested. 

Eq.(2) means that an initially unexcited system can only 
absorb energy as long as the system is dissipative. If the 
supply rate represents the input energy into the system, then 
Eq.(2) states that a system with no initially stored energy 
transforms the input energy into either stored energy or 
dissipated energy. Thus no energy can be generated from a 
dissipative system. Note that the dissipative system defined 
by (1) and (2) are not necessary the systems which 
"dissipate" energy by a usual sense. 

Passivity is defined as a special case of dissipativeness 
defined by (1) and (2). 

Definition 3 [8]: A system is passive if and only if it is 
dissipative with respect to the supply rate 

w(u,y)®u T y (3) 

An algebraic condition for passivity can be found if the 
system is represented by the state-space equations 


The function f(x) is generally not unique for 8 given 
passive system. Nevertheless, the function 4>(x) has a 
physical meaning which is shown in [9] that 

2 f T u T (t)y (t) dt = 4»[x(T)3 - «p[x(t 0 )] 

** T 

+ [ [l(x)+ W(x)u] T [l(x)+W(x)u]dt ® 

Eq.(8) may be interpreted as the conservation of energy 
equation. i$(x) is a stored energy for the system. The left- 
hand side integral of Eq. (8) corresponds to the input energy 
to the dynamic system. The right-hand integral is 
proportional to dissipated energy, and it is always non- 
negative. As a consequence, Eq.(8) means that the energy 
input is equal to the variation of stored energy plus the loss 
of energy which is a positive function. 

A linear system is passive if and only if its transfer 
matrix is positive real [10]. Passivity can thus be seen as a 
generalization of positive realness for nonlinear systems. 
Since the systems investigated here are linear; we will 
equivalently use these two concepts for the rest of this 
paper. 


x® f(x)+G(x)u 
y = h(x)+J(x)u 


3. A VIRTUAL SYSTEM DESIGN 

The multivariable system (Plant (P)) is described by 


where f(x) and h(x) are real vector functions of the state 
vector x, with f(0)=0, h(0)=0, and G(x) and J(x) are real 
matrix functions of x. These four functions are assumed to 
be infinitely differentiable. We also assume that u and y 
have the same dimension. The system is furthermore 
assumed to be completely controllable. Theorem 1 provides 
a test for the passivity of a system written in the form of 
Eq-(4). 

Theorem 1 [9]: The system is passive if and only if there 
exist real functions fix), l(x) and W(x) with 4>(x) continuous 
and with 

<Kx)£0, Vxe/f (5) 


Mx+Dx + KxsBu (9) 

where u is an mxl control vector, x is an nxl state vector, 
M is an nxn symmetric positive definite matrix, D and K 
are nxn symmetric positive semi-definite matrices, and B is 
an nxm matrix. Let a virtual system (V) be defined by the 
following equation 

x> = Ax+Bu 00) 

where L is a pxn matrix, B' is a pxm matrix, and x, is a 
pxp vector. The following theorem allows us to compute an 
output y that will make the global system (a combined 
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system of the given plant and the virtual system) positive 
real Note that since A has pxn dimensions, the number of 
state variables for the virtual system Xg can be made smaller 
than the number of the plant state variables x. 

Theorem 2: Let H v , A be chosen such that 
2H,A = B t 

B t M: = 2H, (11) 

where M, is a px p positive semi-definite matrix. If 

y = H, x. (12) 

then the system with input u and output y is positive real'. 


ro 


h(X) = 


0 

0 

H,x 4 


J(X)=0 


07) 

(18) 


Let a candidate for the function f(X) in Theorem 2 be 

«X) = ix T Mx + ix T Kx + i(x.-Ax) T M. (x.-Ax) 

2 2 2 (19) 


where M, is positive semi-definite. The sum of the first two 
terms corresponds to the stored energy of the plant The third 
term is added to achieve a positive real design. The function 
f(X) can be written using the state variables as 


This scheme is illustrated in Fig. 1 


Acceleration 



Proof: For this proof, it is useful to represent the system 
with a state-space representation. Let 


♦(X) ■ j x JM x, + j x, t K x, + i (x 4 - Ax,) t M, (x 4 - Ax , ) 

( 20 ) 

f(X) is a positive function and f(0)=0. It must be checked 
that there exists a function 1 (X) such that 

V T 4>(X)f(X) = -l T (X)l(X) C1) 

This calculation is considerably simplified when we notice 
that 

V T «.(X)f(X) = ^£>| (22) 

Qt 1.-4 

As a consequence we have 


X*®^* xj xj xJ] = [x T x T x 4 x 4 ] 


(13) 


The equations describing the global system may be rewritten 
as 


X = f(X) + G(X)u 
Y = h(X)+ J(X)u 


(14) 


V T $(X)f(X) = x T (Mx+Kx) 

+^-(x.-Ax) T M. (x, -Ax) + ^(x, -Ax) t M, (x.-Ax) 

*• «■ 

(23) 

When u ■ 0, the last two terms cancel out and therefore 


V T $(X)f(X) = x T (Mx+Kx) 


(24) 


where 


Thus we finally have 



*2 

-M’ 1 D Xj - M* 1 K x, 

x i 

-A M' 1 D x 2 - AM**K x, 


ro 


G(X) = 


M"’B 

0 


AM _, B+B’ 


V T *(X) f (X) = -x T D x = -x\ D x, (25) 

(15) 

Since D is positive semi-definite, it is possible to find a 
matrix R such that D=R T R. The above equality becomes 

06) V T $(X)f(X) = -(R x 2 ) t (R Xj) = -P(X)1(X) (26) 

where 1 (X)=Rx 2 . Thus equality (i) from Theorem 1 is 
satisfied. Equality (iii) of Eq. (7) reduces to 
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J(X) + J T (X) = W T (X)W(X) = 0 (27) 

Tbc function W(X) is therefore equal to zero. Equality (ii) of 
Eq. (7) becomes 

h(X) = ±G T (X)V<>(X) (28) 


zero input if the controller is strictly positive real [3]. That 
is, for this case, we have 

Bm(H.x.) = 0 (34) 

Our next goal is to let x go to zero. Theorem 3 may be used 
to achieve this goal. 


Since the first and third rows of G(x) are zero, only the 
partial derivatives with respect to velocity are needed to 
evaluate Eq. (28). Therefore, we have 


~ - = xj M + (Ax, - x 4 ) t M, A 
= (x 4 - A Xj) T M, 


Theorem 3: Assume that Theorem 2 is used to make the 
global system PR. Furthermore assume that 

(i) B T x = 0 and u = 0 imply x = 0. 

(ii) K is positive definite. 

(iii) The system is connected to a SPR closed-loop 
controller. 

Then limx(t)=0. 


The function h(X) is such that 

2h(X) = (M- 1 B) T ^~ j + (A M-'B + B') T ^j (30) 

Obvious simplifications yield 

2h(X) = (B t -B t M* A)x 2 + B t MJ x 4 (31) 

h(X) is equal to if the following equations are satisfied 

B T -B T MjA = 0 (32) 

B t m:=2H v 

Those equations can be rewritten as 


Fig.2 shows the control scheme for the plant (P) and 
virtual system (V). 


Acceleration 



Figure 2. A SPR Controller for the plant and the Virtual 
System 


2H,A = B t (33) 

B T Ml = 2H. 

and the theorem is proved • 

There are several possible ways to solve the above 
system of equations. Given H v and B, we can solve for 
some possible L, M a and B'. At the end of the calculation, it 
must be checked that M a is positive semi-definite. Another 
method consists of choosing B, L and a positive semi- 
definite M a and then solving for possible B' and H v . Note 

that the choice of the virtual system in Eq. (10) is 
independent of the plant parameter M, D, and K. This means 
that the virtual system will make the global system positive 
real regardless the uncertainty in M, D, and K. 

4. CHOICE OF A CONTROLLER 


Theorem 3 allows us to design a robust controller for 
Plani (P). No knowledge of the constant matrices M, D and 
K is required. Furthermore, the only measurements needed 
are acceleration and input. Acceleration may easily be 
measured for many practical systems by using 
accelerometers. Hie input u may be obtained by measuring 
the output of the SPR controller. 

The proof of Theorem 3 uses the following lemma. 

Lemma 1: Let e(t) be a function of time and let e(t) go to 
zero as time increases. Then if x satisfies the differential 
equation 


where D is positive semi-definite and K is positive definite, 
then x converges to zero. 


If the output of the global system is chosen according to Proof: Let m denote the rank of D. There exists an 

Theorem 2, then the global system is positive real. Thus the invertible nxn matrix P such that 

closed-loop system is uniformly asymptotically stable with 
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D'-PDP 1 (36) 

where 

D- '[o D°] 07) 

Note that since D is positive semi-definite, the aero 

eigenvalues appear on D*. P is an orthogonal matrix 
consisting of the eigenvalues of D matrix. Therefore. D 22 is 
an mxm positive definite matrix. Let K* be defined as 

K'-PKP- 1 (38) 

K* may be written as 



The dynamical equation can be written as 

PDP- , (Px) + PKP' , (Px) = Pe(t) (40) 

Let y =Px and T\(t) = Pe(t). The system is now described 
by 


strictly stable, when y goes to zero, u also goes to zero. 
Furthermore, we have 

2H,x, =2H, Ax+2H,B‘u ( 44 ) 

by multiplying Eq.(10) with 2H*. Since 2HvA=B T , this 
equation may be rewritten as 

B t x = 2H, x.-2H.B‘u (45) 

2H v B'u goes to zero as u goes to zero. Furthermore, we 
know that y=H y x, converges to zero as time increases. 

Let x,. denote the state of the SPR controller. Since the 
controller is linear, the system can be described by 

x t = Rx t + Sy 

y* = Tx t (46) 

where R, S, and T are constant matrices. Therefore, the 
global system becomes 

Mx + Bx + Kx = -BTx t 
y = (H,A)x - (H y B’T)x t 

x t -Rx t + Sy ( 47 ) 


D*y + K*y = i)(t) (41) 

Let y = ) and *1 = (jj'J. Eq. (41) is reduced to 

K n y> + ^12 y 2 = ^1 (0 (42) 

9 2 + Kjj y« + y } * t ) 2 (t) 1 ; 

The first equation of (42) can be solved in terms of yj, and 
Eq. (45) reduces to 

y» = -K„‘ y 2 + Kji* T)j (t) 

D * y 2 + (k» - kx k ; 2 ) y , = i), (o+kx? t,, (o 

(43) 

Note that since K is positive definite, Kj, is invertible. D 22 

and (K^j - K^Kij ' 1 Kj 2 ) are positive definite matrices. Thus 
y 2 may be considered as the output of a strictly stable 

system. The output of the strictly stable system converges 
to zero. The parameter y 2 will therefore go to zero. The first 
equality in Eq.(43) shows that yj also goes to zero. 
Consequently, y converges to zero and so does x. 


Further define x = [x T x T xJy T ] T . Eq. (47) is rewritten in 
die form 

x = Ax (48) 

where 

■ 0 1 0 O' 

-M-‘K -M‘'B -M-'B t 0 
A= 0 0 R S 

. 0 H,A -H y B’T oj (49) 

Since A is constant, the solution for y can be rewritten as 

y = Xa i e <vW P i (t) 

‘ (50) 

where a, are complex constants and 

P.<0-£fct M 

« (51) 

Note that n is the number of dimension of matrix A. Since 


Proof of Theorem 3 : Refer to Fig.2, (-u ) is the output J*™ y( l) = 0 , < 0 for all i. Therefore, 

of the SPR controller. Since a SPR controller is always 
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lim^ = lim(£ a i( a » + jb.H^^p.d) 

+ y ait <vwM )= o 

i dt (52) 

As a consequence, B T x goes to zero. The equations 
describing the system are linear and consequently 


M and K are positive definite as long as none of the masses 
and the spring constants is equal to zero. Several possible 
controller designs can be used here. Although we select msp 
in the following example, m*p is allowed for this 
controller design. 

m=n=p=3 


continuous. Thus, if B T x and u go to zero, x goes to zero 
according to assumption (i) in Theorem 3. The dynamics of 
die closed-loop system is now 

Dx + Kx«Bu-Mx = e(t) (53) 


There are three control parameters here. A reasonable 
choice is 


B 


fl 0 01 
0 1 0 
0 0 1 


(58) 


where e(t) vanishes as time increases. Using Lemma 1 we 
conclude that x (t) goes to zero. 


and the control vector u is defined by u T =[u, u 2 u,). 
Obvious solutions to Eq.(ll) are given by 


5. EXAMPLES 


Two spring-mass systems will be used to demonstrate 
the controller design. 


The first example is a system with three masses, three 
springs and no dashpots. The example is shown in Fig. 3. 


I 


xl 


x2 


kl k2 k3 


x3 


Figure 3. A Spring-Mass System 

This system needs to be stabilized as it is not naturally 
asymptotically stable. With no control and non-zero initial 
conditions, the three masses oscillate since there is no 
damping. The dynamic equations describing the system in 
Fig.3 are 


m, xi+ (Itj + k 2 ) x, k 2 x 2 — Uj 
> m 2 xa-k 2 x,+(k 2 + k 2 )x 2 -k,x,eu 2 
m,xj-k,x 2 + k,x, = u, 


(54) 


The matrices M, D and K are 


h.= 1 b t 

B'=XB 


(59) 


where X. is an arbitrary strictly positive real number. As a 
consequence, the virtual state vector x, is generated by the 

differentia] equation 


x. = x+XBu (60) 

All the assumptions of Theorem 3 are satisfied. The vector x 
may therefore be controlled with the help of any SPR 
feedback controller. A simple choice is a constant controller, 
that is a controller with a transfer matrix of the form k I, 
where I is the identity matrix and k is a constant. 

The following values are used in the simulation: 

m j » m 2 ~ m 2 = 1 
kj = 1 k 2 = 2 k 2 = 3 

The initial conditions are arbitrarily chosen to be 

x^O) = 5 x 2 (0) = -2 Xj(0) = 9 

k,(0) = 3 x 2 (0) = 5 Xj(0) = -4 


(61) 

(62) 


(63) 

(64) 



’m, 0 O' 

M = 

0 m 2 0 


0 0 m, 

D = 0 


ki +k 2 

-k 2 0 

K = 

-k. 

k 2 + k, -k 


0 

-k, 


£3) For the vector x B , we choose the simple initial conditions 

x, = 0 x t * 0 (65) 

(56) 

The constant X is selected to be 0.5. The gain of the 

(57) feedback controller is k *1. The three displacements of the 

three masses are shown in Fig. 4. In the following figures, 
xi is indicated by — > xj is indicated by ... and X3 is 
indicated by . 
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t 



' ( 68 ) 



Figure 4 Displacements of xj, xj, and X 3 


and the output of the system is y * ^x, . In this example, 

the number of the virtual states is less than the number of 
the plant states. 

A SPR controller must be chosen to control the system. 
Here again, a constant controller is a possible choice. Its 
transfer matrix is k I, where k is a positive constant. 


It remains to ensure that B T x = 0 and u=0 imply x=0. If 

B t x = 0 and u*0, then the dynamical equations of the 
system become 


(kj +k 2 )Xj + kjXj = 0 

- -k,x, + (k, + k,)x 2 -k,x, = 0 
m, xj-kjXj + kjX, = 0 


( 69 ) 


The control goal is achieved since the three 
displacements vanish with time. Nevertheless, this design 
requires that a force be spplied to each masses. It is possible 
to reduce the number of actuators with the following control 
designs. 

m=ps2 


By differentiating the second equation and solving for xj, we 
have 


k, - (kj + kj) • 

xj *--ixj+^ — 

*2 k : 


Xl 


( 70 ) 


Here only two forces are applied to the system. Thus 
there are three possible choices, depending on what masses 
the forces are applied. Let us assume 


n oi 


B = 


0 1 
0 0 


( 66 ) 


This choice means that the forces are applied to the masses 

mi and m 2 only. The control vector u is isu T * [u, u 2 J. 
The vector x t is now a vector with dimension 2. Eq.(l 1) has 
the following solution 


Since xi and x 2 are both equal to zero, x 2 is also equal to 
zero. Thus Eq. (69) is reduced to Kx « 0. Since K is positive 
definite, this yields x ■ 0. Therefore, all the assumptions of 
Theorem 3 are satisfied and we are now assured that x will 
go to zero. 

The closed-loop system is simulated with the same 
parameter choice as before. The three displacements are 
shown in Fig. 5. Here again the stabilization is achieved 
since the three displacements vanish as time increases. 


A=B t 

H * - *^* 1 (67) 

M.-£i» 

where X is an arbitrary strictly positive real number , and 
where I denotes the 2x2 identity matrix. Thus x a can be 

computed from the following differential equation. 
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Figure 5 Displacements of xj, X 2 t and X 3 

It is also possible to stabilize this system with a 
different distribution of forces. For instance, two controllers 
are applied to mass 2 and mass 3 or two controllers are 
applied to mass 1 and mass 3. The results are all similar to 
Fig. 5. 

fflsAsl 

Here we design a control system with only one actuator. 
This actuator may be located on any of the three masses. Let 
us first apply a force on mass 1, Le. the matrix B is 


strictly positive real number. With this choice x converges 
to zero. 

It should be checked as before that B T x - 0 and u =0 

imply x = 0 . The procedure is unchanged and once again 
those assumptions yield K x * 0. Since K is assumed to be 
positive semi-definite, x must be equal to zero. 

The simulation is ran with the same choice of initial 
conditions. The constant X is still equal to 0.3, and k is 
equal to 1. The three displacements go to zero as expected 
which can be seen in Fig. 6 . 


1 


• I 



4 1 • 1 

0 10 30 30 40 30 60 70 10 

Time 


B = 


1 

0 

0 


(7D 


Eq.(l 1) in Theorem 2 has the following obvious solution 


Figure 6 Displacements of xj, xj, and X 3 

The force could be applied to mass 3. However, if we 
choose to apply the force on mass 2 , the design cannot be 
completed. In this case. 


A =B t 

H.-I 

B'= X 

M.a 


(72) 


where X is an arbitrary strictly positive real number. The 
state x a is calculated by integrating the differential equation 


X. = Xi + — u 

/v 


The output of the system is y = -jj-x, . 


(73) 



(73) 


It can be checked that condition (i) of Theorem 3 is not 
satisfied. Thus no controller design can be implemented with 
the above choice. 


To see the robust stability, let's study the example with 
m=n=p=3 again. The system is now perturbed to mi=1.5, 
m 2 = 2 , 013 = 3 , ki» 2 , k 2 * 1 . 5 , and k 3 = 3.5 while the controller 
is kept the same as before. The simulation is shown in Fig. 
7 which clearly indicates robust stability. 


Here again a SPR controller is chosen to be constant. Its 
transfer matrix is of the form G(s) = k, where k is any 
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Figure 7 Displacements of xj, X 2 , and X 3 


The second system consists of one spring and one mass. 
The system is described by 

mx+kx = u 

y = * (75) 

If a simple integration of the output acceleration is used for 
the feedback control, it can be shown that 


lim = £[x( 0 )-c( 0 )] 


(76) 


regardless of the initial velocity x(0). Therefore, the 
asymptotic stability of this design is independent of the 
initial velocity. 

The performance of the controller can be obtained by 
optimization. The real part of the closed-loop eigenvalues 
can be minimized with respect to the feedback gain. For 
m*l and k=l,the optimal feedback gain d is calculated to be 
d=0.52. Fig. 8 shows the response for the optimal feedback 
gain d=0.52, and Fig. 9 shows the response for the feedback 
gain d=2. It is clear that when d=0.52 the system performs 
better than the system with d= 2 . The robust performance is 
also demonstrated in Fig. 9 in which the mass and spring 
constants are perturbed to m= 1.5 and k= 1 . 2 . 



where d is the feedback gain, x( 0 ) is the true initial 

velocity, and c(0) is the estimated initial velocity. Since Figure 8 Displacement for d= . 

velocity is not measurable, c( 0 ) is not equal to x( 0 ). 

Therefore, asymptotic stability is not achieved. 


However, if a virtual system is used by selecting 


A * 1,H, * j *B = 1*M» * 1 


(77) 


The global system is robustly positive real. Using a simple 
constant feedback with 2 d as the gain leads to the following 
closed-loop system 

mx + kx = u 
x, = x + u 

u = -dx. (78) 


It can be shown that 

Jim[ £ xdt - (“-j^-)x(O)] = 0 
lim x(t) = 0 



Figure 9 Displacement for d =2 
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Figure 10 Displacement for m=1.5, k=1.2, and d=0.52 
6. CONCLUSIONS 

In this paper, a virtual system has been developed for 
second-order systems with only acceleration output. The 
combined system of the virtual system and the second-order 
system is positive real which allows infinite uncertainty in 
mass, spring constant, and damping coefficient The states 
of the virtual system are not necessary the same as the states 
of the plant. The number of the virtual states can be made 
smaller than the number of the plant states. Furthermore, 
any strictly positive real controllers can be used to achieve 
the asymptotic stability of the closed-loop system. This 
design is particular of interest for practical applications since 
only acceleration measurement is required. Asymptotic 
stability can be achieved with infinite uncertainty in the 
system parameters and a large set of SPR controllers can be 
selected to optimize the performance. Two spring-mass 
systems have been used to demonstrate the virtual systems 
and controller designs. Extension to robust performance 
along this line of research is possible since one of the 
examples has been shown with some degree of robust 
performance. 
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Abstract 

A feedback linearization technique is used in 
conjunction with passivity concepts to design robust 
controllers for free base robots. It is assumed that 
bounded modeling uncertainties exist in the inertia 
matrix and the vector representing the coriolis, 
centripetal, and friction forces. Under these 
assumptions, the controller guarantees asymptotic 
tracking of the joint variables. A Lagrangian approach 
is used to develop a dynamic model for space robots. 
Closed-loop simulation results are illustrated for a 
simple case of a single link planar space manipulator 
with freely floating base. 


Introduction 

The dynamics of the space manipulators differs 
from that of the ground based manipulators since their 
base, the spacecraft, is free to move. The movement of 
the manipulator produces reaction forces and torques on 
the base. Therefore the resulting motion of the 
spacecraft has to be accounted for in the dynamic model 
for the manipulator. However, it is shown in reference 
[1] that a dynamic model for space robots developed by 
taking into account the motion of its base is similar in 
structure to dynamic models of fixed base manipulators. 
For instance, the inertia matrix in each case is 
symmetric and positive definite. 

A few concepts have been proposed for joint 
trajectory control and inertial end tip motion control of 
space manipulators. Vafa and Dubowsky [2] developed 
an analytical tool for space manipulators, known as the 
virtual manipulator concept. The virtual manipulator is 
an idealized kinematic chain connecting its base, the 
virtual base, to any point on the real manipulator. This 
point can be chosen to be the manipulator's end 
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effector, while the virtual base is located at the system 
center of mass, which is fixed in inertial space. As the 
real manipulator moves, the end of the virtual 
manipulator remains coincident with the selected point 
on the real manipulator. Additionally, it can be shown 
that the change in orientation in the virtual 
manipulator's joints is equal to the change in the 
orientation of the real manipulator's joints. While these 
features give the designer the ability to represent a free 
floating space manipulator by a simpler system whose 
base is fixed in inertial space, the associated 
transformation depends on knowing the system 
parameters exactly. Alexander and Cannon [3] showed 
that the end tip of the space robot can be controlled by 
solving the inverse dynamics that includes motion of 
the base. Their method assumes the mass of the 
spacecraft to be relatively large compared to that of the 
manipulator 'it carries, and also requires much 
computational effort to determine the control input. 
Note that, future systems are expected to have the 
manipulator and spacecraft masses of the same order. 
Umetani and Yoshida [4] proposed the generalized 
Jacobian matrix that relates die end tip velocities to the 
joint velocities by taking into account the motion of the 
base. The control method presented in the above 
reference is based on the concept of Resolved Motion 
Rate Control. However, only the kinematic problem 
was treated. Masutani et al. [5] proposed a sensory 
feedback control scheme based on an artificial potential 
defined in the sensor coordinate frame. This scheme is 
based on proportional feedback of errors in the end tip 
position and orientation as well as feedback of joint 
angular velocities. 

In this paper a robust control scheme based on 
feedback linearization and passivity concepts is 
proposed for space robots. A similar control scheme 
has been proposed earlier for fixed base robots [6]. The 
extension to space robots is in the spirit of the [1], 
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where it was proposed that doe to the striking similarity 
in the structure of the equations of motion of fixed and 
free base robots; almost any control scheme used for 
fixed base robots can be applied to free base robots. 
The control scheme uses inverse dynamics; however, it 
is robust in the face of bounded modeling uncertainties 
which might be due to imprecise modeling and/or 
intentional simplifications to the model based control 
law in order to reduce computational effort. The 
controller asymptotically tracks prescribed time varying 
joint angle trajectories whose acceleration is bounded in 
the L 2 space. 


Dynamics of Space Manipulator System without 

Attitude Control of the Base 

The development of the equations of motion for 
space robots presented here closely follows that given 
in [5]. A space manipulator system in the satellite orbit 
can be approximately considered to be floating in a 
non-gravitational environment. As shown in Figure 1, 
the manipulator and the base can be treated as a set of 
n+1 rigid bodies connected through n joints. The 
bodies are numbered from zero to n with the base being 
0 and the end tip being n. Each joint is then numbered 
accordingly from one to n. The angular displacements 
of the joints can be represented by a joint vector, 

q * Iqj q 2 -q„] T 0) 

The mass and inertia tensor of the i^ 1 body are denoted 
by mi and lj, and the inertia tensor is expressed in the 
base frame coordinates. 

Kinematics 

A coordinate frame fixed to the orbit of the satellite 
can be considered to be an inertial frame, denoted by Zj. 
In addition to Zj, another coordinate frame Zb is 
defined that is attached to the base with its origin 
located at the base center of mass. The attitude of the 
base itself is given by roll, pitch, and yaw angles. In the 
sequel, all vectors are expressed in the base fixed 
coordinate axes. 


Ob are the linear and angular velocities of the base with 
respect to the inertial frame, vj and ci>j feu- each link can 
be represented by the following forms 

v i = Jii(q)q (5) 

= J*(q)q (6) 

where JLi(q) and JAi(q) e R 3xn are the Jacobian 
matrices for the i* link. 

The position of the system center of mass with 
respect to the base frame depends on the joint angles. 
Given below are two measures related to the system 
center of mass 

m e = 5X (7) 

i*0 

r c (q)=im i r i (q)/m e (8) 

i-0 



Let Vj and D; be the linear and angular velocities 
with respect to the inertial frame, and ©j be the angular 

velocity with respect to the base frame for the i* link. '' Earth ^ 

Then for the i* link 

v i ■ Vb + vj + Ob * T i (3) 

Figure 1 . A Free Base Space Robot. 

fli * OB + ©i (4) 

Dynamics 

where r, is the position vector of the i th body with The total kinetic energy of the space robot can be 
respect to the base center of mass, and v i = r j . Vb and wntten as 
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i 

t 

i 


f 


T =— q T D(q)q, D€R" xa 
2 


Since there is no potential energy in non- 
gravitational environment, the Lagrangian, A, is equal 
to the kinetic energy 


where D is the inertia matrix of the system and is given 
by 


d -*vk y*[H (10> 

It can be shown that D * D T > 0. Hq is the inertia 
matrix corresponding to the fixed base manipulator 

H,=i[ mi JLJu+jLliJAi]. H,€R BXD (11) 

i*l 


The second term on the right hand side of Equation (10) 
arises due to the fact that the base of the space robot is 
free. Since the working environment is non- 
gravitational and no actuators generating external forces 
are employed, the linear and angular momenta of the 
whole system are conserved. Since the inertial frame is 
fixed to the orbit, the whole system can be assumed to 
be stationary at the initial state. Thus the above two 
momenta are always zero for the whole system. Note 
that it is implicitly implied that the satellite is a non- 
spinning body. Using the assumption of zero initial 
momenta the individual components comprising the 
second term on the right hand side of Equation (10) can 
be written as 


H v = m e I 3x3 , H v aR 3 * 3 (12) 

Ho-IIi + iniilrixftriX], H Q eR 3 * 3 (13) 

i«0 i*l 

Hyfl = -m e [r e x), H vQ eR 3 * 3 (14) 

Hvq = X m i^Li» H^aR 3 *” (15) 

i*l 

+ H^aR 3 * 11 (16) 


where for any vector 


1 

N 


II 

*2 






r 0 

-f 3 h) 

[fx]* 

*3 

0 

-ft 



U 

o J 


(17) 


(18) 


A = T (19) 

So die system dynamics are given by 



where % is an nxl vector of input torques. Paralleling 
the development for fixed base robots in [7], the 
equations of motion for space robots can be written as, 


D(q)q + h(q,q)*t 

where 


(21) 

h(q,q) = C(q,q)q 


(22) 

and the elements of the matrix C are given by 



'Qi 

(23) 

* 3q» dQj 3 q k J 

»i 

Base Motion 




The conservation of linear and angular momenta 
yields expressions for the base translational and angular 
velocities 



Using the above expressions, the evolution of the base 
position and orientation with time can be determined as 
follows 


V 


CyCg 

C ¥ SeS# 

C ¥ s e c t + s ¥ s* 

yb 

= 

s ¥ c e 

s ¥ ses t + 


A. 



c e s 4 

c e c 4 _ 


V B (25) 


V 


1 s* tan(0) c* tan(0) 

0 

= 

0 c* -s* 

V. 


0 s 4 sec(0) c*sec(0) 


(26) 


where 

' c 0 «cos(),s ( .j«an() (27) 


and 13 x 3 is the 3x3 identity matrix. 


» 
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Control System Design 


Feedback Linearization 

Assuming that the dynamics of the space robot are 
described by Equation (21), where D and h are 
completely known, the feedback linearization or inverse 
dynamics technique [7] can be used to design 
controllers for tracking prescribed command trajectories 
for the joint angles. This can be accomplished by 
letting 

t = Du + h (28) 


Robust Feedback Linearization Using Passivity 

The development in this section follows that given 
in [6] very closely. In the presence of modeling 
uncertainties, the control law is given as 

t = D c u + h c (33) 

where D c and h c are computed versions of D and h 
respectively. Substituting for t and u from Equations 
(33) and (31) into Equation (21) it can be shown that 
the closed-loop system dynamics are given by 


where u is the pseudo-control, i.e., it is the control input e = A c e + B v (34) 

to the linearized system. With the control law given by 
Equation (28), the closed-loop system becomes where 



(29) 


and 


v = Au + 6 


(35) 


where 


A = 



A simple PD (Proportional-Derivative) type of control 
law is chosen for the feedback linearized system 


u = q d + K 2 (q, i -q)+K 1 (q d -q) (31) 


A = (I-D -, D e ), 6 = D' 1 (h-h c ) (36) 


The first step in the design proposed in [6] is to choose 
the gain matrix K = [Kj K 2 ] and an output matrix F 
such that the linear system given by 


e = A c e + Bv 
y =Fe 


(37) 


where K] and K 2 are proportional and derivative gain 
matrices, respectively. These matrices are usually 
chosen to be diagonal in order to achieve decoupled 
response among the joint angles. Substituting for u 
from Equation (31) into Equation (29), one obtains 

e = A c e (32) 

where e= {ej eJ) T ,ei =q d -q, e 2 =q d -q and 
A t = A-BK. If Ki >0 and K 2 > 0, the error 
dynamics as given by Equation (32) are asymptotically 
stable. The freedom in selecting the gain matrices can 
be utilized to meet performance specifications for the 
closed-loop system. 

The preceding discussion assumes availability of 
perfect knowledge about the system dynamics. 
However, in practice, D and h are usually imprecisely 
known due to modeling inaccuracies. Furthermore, D 
and h may be too complex to be used for real-time 
control implementation. In the following sub-section, a 
control law that is robust for bounded uncertainties in D 
and h is given. The control law results in closed-loop 
asymptotic tracking. 


is SPR (Strictly Positive Real) [8]. This can be 
achieved as follows. 

Theorem 1 [6]. Let Kj and K 2 be such that 

Kj = diag[k a ]; k h > 0, i = l,...,n 

K 2 = diag[k 2i ];k 2l >0,i = l n (38) 

(k 2 i) -^kjj, i = l,...,n 

then if F = K, the system described by Equation (37) is 
SPR. 

The proof is omitted here, the interested reader is 
referred to [6]. Note that the conditions of the theorem 
given in Equations (38) are extremely easy to satisfy. 

With the linear system (37) being SPR, the 
passivity theorem [9] can be used to design 
asymptotically stable controllers as shown in the 
following theorem. The theorem is very similar to that 
given in [6], with the only difference being in the way 
in which the uncertainty bound on the h vector is 
characterized. 
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Theorem 2. Let the following two inequalities hold 


one can obtain 


I t 2(ar-l)|u£ 


D<-I (r>0) (39) 

r 

[D-'Ch-he)^ c|u| T +d VT>0 

(c^O.d^O) (40) 

Furthermore, let q d e L 2 . Then if D c *=al where 


c+1 


a> 

r 


(41) 


(45) 


On the other hand, 

-1 2 = J u t D _ 1 (h - h c )dt 
o 

S Iu^Jd - 1 (h - hc)^ (Holder 1 s Inequality) 
s I u M c I u It + d] (46) 


the closed-loop system is asymptotically stable. 

Proof. The closed-loop system as given by Equation 
(34) can be represented in block diagram form as shown 
in Figure 2. It is first shown that the nonlinear block in 
the feedback path is passive [9]. 



Figure 2. Robust Feedback Linearization Using 
Passivity Theorem. 


Consider 

T 

I = ]-u T vdt (T>0) 
o 


T 

= j-u T (Au + 5)dt 
o 



Let the first and second integrals on the right hand side 
be denoted by 1\ and I 2 respectively. Then 

Ij = J u T (aD -1 - I)udt (43) 

0 


Hence 

I £ (ar - c - l)|u£ - dink = f (|u| T ) (47) 

It can be shown that if (ar - c - 1) > 0, then 

f (l“lr)^- 4 ( ^;V-i ) V|a|Ta0 <48) 

Hence 

J— u T vdte- d * - VT>0 (49) 
0 4(ar-c-l) 

Thus a sufficient condition for the nonlinear block to be 
passive is that a > (c + l)/r. 

Additionally, the transfer function of the 
feedforward block [A c , B. K] is proper and has no poles 
on the imaginary axis. Hence it has finite gain [10], 
Since q d e L 2 , then using the passivity theorem [9], 
one can conclude that the signals u, Ke, and v are 
bounded. Moreover, since the feedforward block is 
SPR, Ke(t) = K,e,(t) + K 2 e 2 (t) goes to zero 
asymptotically. This in turn implies that c, (t) and ej(t) 
individually approach zero asymptotically [8]. 

The first condition of the theorem, given by 
Equation (39), is easy to satisfy since D is upper 
bounded. However, the second condition, given by 
Equation (40), might not be easy to verify in a 
straightforward manner in all applications. 


Simulation Results 


Noting that 

D <-I => aD~’ — I > (ar — 1)1 (44) 

r 


As an example, results are illustrated for a single 
link space robot shown in Figure 3. Equation (21) 
describes the dynamics of this one degree of freedom 
system. The system inertia, computed using Equation 
(10), turns out to be 
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D(q 1 )=m'P? + I 1 -i[m'l> J (P 0 c 1 + P 1 ) + I 1 ] 2 (50) 

a 

where 

d = m'(P 2 +P? + 2P 0 P,c l )+l 0 + I 1 (51) 

and m' * m 0 m t / (m 0 + mj). Using Equations (22) 
and (23), b is determined to be 

h(qi.4i)-^^[mT.<p c + P,c,)+ IJ* 
CmT» 1 (P 0 c 1 + P 1 )+I,)qf 

In Equations (50) through (52), 
CjBcosfajXsj-sintq!). 



Figure 3. A Single Link Planar Space Robot 
It can be seen easily that as mo «*, and Io -* «», 

D-»m 1 Pf + I 1 , h-»0 (53) 

which represents the case of a fixed base manipulator. 
Equation (25) is used to determine the evolution of the 
base position with time 


* b = n^[ P,S * 1 ~ (P ° Cl + P,) + ^ ' 

(P,s v , + P 0 s v )]qi 

(54) 

y b « £[-P,c* + ^{mT^oC + Pi) + 1]} • 

(PiC ¥) +P 0 c v )]qi 

where 

s^i * sin(v + q t ), c v j = cos(y + q, ) (55) 

Finally, the base attitude dynamics is obtained using 
Equation (26) 

V = -i[m'P,(P 0 c 1 + P,) + Ii]q 1 (56) 

Next, a feedback controller is designed for the 
space robot using the results of Theorems 1 and 2. 
Closed-loop results are generated for a step command 
of 1 radian to the joint angle. Note that in general, for 
end tip motion control in the inertial space, the inverse 
kinematics problem needs to be solved to generate a 
command trajectory for the joint angle. Table 1 lists 
physical parameters of the example robot used in 
simulation. The base and link masses are of the same 
order of magnitude. 


Table 1. Physical Parameters of Example Robot. 


Body 

p (meter) 

1 (meter) 

m(kg) 

I (kg.m^) 

0(Base) 

3.0 

- 

5.0 

30.0 

1 (Link) 

3.0 

6.0 

1.0 

3.0 


Hie feedback gains are chosen to be ki * 0.4 and kj = 
1.0. This choice of gains satisfies Equations (38) and in 
case of no modeling uncertainty, yields a closed-loop 
response without any overshoot. The fact that the 
system center of mass should remain stationary in 
inertial space is used to monitor numerical accuracy of 
integration. Simulation results are shown for the case in 
which there is no modeling uncertainty, and for two 
other cases that involve differing degrees of uncertainty. 
It is assumed that Equations (21) and (50) through (52) 
represent the true robot; the uncertainty is introduced in 
computing D and h. An upper bound for the system 
inertia, needed for condition (39) of Theorem 2, is 
given for this particular case by 

•ism'Pf + I, (57) 

a in Theorem 2 is assumed to be 1.1 /r for both cases 
involving uncertainty. The choice of he however, is 
different for the two cases. In the first case, the 



following simplification to h is used for computing the 
closed-loop control 

h e = m'P 0 P,s,q 1 (58) 

The second case corresponds to an even greater 
simplification to h 


h e = mT^qi (59) 

Figures 4 through 7 show closed-loop results for 
the nominal case and for the first case involving 
uncertainty, c ■ 0.01 was chosen to satisfy condition 
(41) of Theorem 2. d was chosen to be 2.5. Figure 4 
shows that asymptotic tracking in the joint angle is 



achieved in the face of uncertainty. This is associated 
with a slight performance degradation in the joint angle 
response in the sense that it has an overshoot Figure 5 
shows that higher magnitudes of joint torque are 
required for the case involving uncertainty. Figures 4 
and 6 show that the base moves in reaction to link 
motion; this is due to the conservation of linear and 
angular momentum as discussed previously. However, 
the joint angle still achieves the right commanded 
value. Figure 7 shows that the choice of c and d used in 
this case satisfies condition (40) of Theorem 2. 
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Figure 6. Motion of the Base Center of Mass for the 
Nominal Case and the First Case Involving 
Uncertainty. 


Figure 4. Joint and Base Angle Responses for the 
Nominal Case and the First Case Involving 
Uncertainty. 



Figure 5. Joint Torque Input for the Nominal Case and 
the First Case Involving Uncertainty. 



Figure 7. The Quantity c|4r + d 'I 0 '(h-hcllj. for 
the First Case Involving Uncertainty. 

Figures 8 through 11 show closed-loop results for 
the nominal case and the second case involving 
uncertainty. For the second case, c and d are chosen to 
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be c = 0.01 and d = 5.0. Trends similar to the previous 
case are noticed here also. However, since the extent of 
nncertainty is greater, there is more deviation in the 
responses as compared to the previous case. This is 
observed in Figures 8 through 10. Figure 11 confirms 
that the choice of c and d satisfies the requirements of 
Theorem 2. 



Figure 8. Joint and Base Angle Responses for the 

Nominal Case and the Second Case Involving 
' Uncertainty. 



Figure 9. Joint Torque Input for the Nominal Case and 
the Second Case Involving Uncertainty. 



Figure lO.Motion of the Base Center of Mass for the 

Nominal Case and the Second Case Involving 
Uncertainty. 



Figure 11. The Quantity c|uJ T + d - Jd -1 (h - h c )| T 
for the Second Case Involving Uncertainty. 

asymptotic joint angle tracking in the face of bounded 
uncertainties. For the first time, closed-loop simulation 
results are presented using this control method. For the 
simple example illustrated in the paper, the control 
method shows promising results. 


Conclusions 

A control method based on feedback linearization 
and passivity concepts that was proposed earlier for 
fixed base robots is modified and extended to the case 
of free base robots. The control law results in 
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Abstract 

For robotic manipulators, nonlinear control using 
feedback linearization or inverse dynamics yields good 
results in the absence of modeling uncertainty. 
However, modeling uncertainties such as unknown joint 
friction coefficients can give rise to undesirable 
characteristics when these control systems are 
implemented. In this work, it is shown how passivity 
concepts can be used to supplement the feedback 
linearization control design technique, in order to make 
it robust with respect to bounded uncertain effects. 
Results are obtained for space manipulators with freely 
floating base; however, they are applicable to fixed base 
manipulators as well. The controller guarantees 
asymptotic tracking of the joint states. Closed-loop 
simulation results are illustrated for a planar single link 
space manipulator. 


1. Introduction 

The dynamics of space manipulators differs from 

that of fixed base manipulators since their base is free to 

move. The base could be either a spacecraft or a 
satellite. The movement of manipulator arms produces 
reaction forces and torques on the base. Therefore the 
resulting motion of the base has to be accounted for in 
the dynamic modeling of the manipulator. However, 
Papadopoulos and Dubowsky 1 * showed that a dynamic 
model for space manipulators with a free base is similar 
in structure to the dynamic model for fixed base 
manipulators. An obvious similarity is that the inertia 
matrix in each case is symmetric and positive definite. 
In fact, the dynamic model for fixed base manipulators 
can be viewed as a subset of the model for space 
manipulators. In the past, a great deal of attention has 
been paid by researchers in the area of dynamic 
modeling of space manipulators. Some interesting 


* Postdoctoral Fellow, AIAA Member, 
t Assistant Professor, AIAA Senior Member. 

$ Principe] Scientist, AIAA Fellow. 

‘Copyright 01994 by the American Institute 
of Aeronautics and Astronautics. All rights reserved.” 


notions have emerged from modeling studies, of 
significant importance among which is the idea of 
virtual manipulators 3 . On the other hand, little effort 
has been made in the area of robust tracking control law 
synthesis for space manipulators. A few concepts have 
been proposed for joint trajectory control and inertial 
end tip motion control of space manipulators. 
Alexander and Cannon 3 showed that the end tip of a 
space robot can be controlled by solving the inverse 
dynamics that includes motion of the base. Their 
method assumes the mass of the spacecraft to be 
relatively large compared to that of the manipulator it 
carries, and also requires much computational effort to 
determine the control input. Note that some future 
space systems are expected to have the manipulator and 
spacecraft masses of the same order. Yoshida and 
Umetani 4 proposed the generalized Jacobian matrix that 
relates the end tip velocities to the joint velocities by 
taking into account the motion of the base. However, 
robustness of the control scheme with respect to 
modeling uncertainties was not addressed. 

A nonlinear controller based on feedback 
linearization and passivity concepts was developed by 
Chuang, Mittal, and Juang 3 . The feedback linearization 
technique for nonlinear control system design has been 
generally accepted to yield good results. However, 
these type of controllers require full inversion of the 
nonlinear system model in real-time. This 
computational imposition can restrict and limit the 
applicability of the technique. In Ref. 5, it was shown 
that if simplifications to the nonlinear model are made 
in a manner such that the passivity of the closed-loop 
system is preserved in a certain sense, the feedback 
linearization technique retains it's asymptotic 
stabilization properties. 

In this paper, a nonlinear dynamic model for space 
manipulators with uncontrolled base is first derived. 


The development of the expressions for linear and 
angular momenta of the system closely follows that 
given in Ref. 6; however, the form of the final equations 
of motion is different It is then shown how passivity 
concepts can be used in conjunction with the feedback 
linearization technique to design robust nonlinear 
controllers for space manipulators. The proposed 
control scheme can be used for fixed base manipulators 
also. The control scheme uses inverse dynamics; 
however, it is robust m the face of bounded modeling 
uncertainties which might arise due to a number of 
factors including improper friction modeling. The 
controller asymptotically tracks prescribed time varying 
joint angle trajectories whose acceleration is bounded in 
the L 2 space. 


2. Nonlinear D ynamic Model of the Space Manipulator 
System 


Base Frame 



Fig. 1. A Space Robot 

The development of a nonlinear dynamic model for 
a space manipulator system whose base is uncontrolled 
is discussed in this Section. A space manipulator 
system in a satellite orbit can be approximately 
considered to be floating in a non-gravitational 
environment As shown in Figure 1, the manipulator 
and the base can be treated as a set of ih- 1 rigid bodies 
connected through n joints. The bodies are numbered 


from zero to n with the base being 0 and the end tip 
being n. Each joint is then numbered accordingly from 
one to n. The angular displacements of the joints can be 
represented by a joint vector, 

q - [q 2 q 2 ...q n f (1) 

The mass and inertia tensor of the i* body are denoted 
by mi and lit and the inertia tensor is expressed in terms 
of the base frame coordinates. 

2.1 Kinematics 

A coordinate frame fixed to the orbit of the satellite 
can be considered to be an inertial frame, denoted by Zj. 
In addition to li, another coordinate frame 1 b is 
defined that is attached to the base with its origin 
located at the base center of mass. The attitude of the 
base itself is given by roll, pitch, and yaw angles. In the 
aequel, all vectors arc expressed in the base fixed 
coordinate axes. 

Let Ri and rj be the position vectors of the center of 
mass of the i* link with respect to frames I] and 1 b. 
respectively. Then 

Ri-RB + 'i (2) 

where Rb is the position vector from the origin of the 
frame lito the base center of mass. Let V, and Clj be 
die linear and angular velocities of the center of mass of 
the I th link with respect to frame li and vj and tOj be the 
linear and angular velocities of the same point with 
respect to frame 1 b- Then Vj and flj can be written as 

Vj « V B + Vj + flg XTj (3) 

Qj*n B + (Oi (4) 

Vb and Qb are die linear and angular velocities of the 
base center of mass with respect to frame Xj. Note that 
for any space manipulator, v, and w, for each link can 
be represented by the following forms 

Vi « Jti(q)q (5) 

* JAi(q)q < 6 ) 

where JLi(q) and JxKq) <= R 3xn are the Jacobian 

matrices for the i* link. 

Tbe position of the system center of mass with 
respect to the base frame depends on the joint angles. 
Given below are two measures related to the system 
center of mass. 

m e * X m » 07) 

i»0 
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r 


r,(q)= isJL 


ImjiCq) 


m. 


( 8 ) 


= — [Hq — HJqH^’Hvq]” 


(19) 


22 Linear and Angular Momenta 

The linear momentum P and the angular 
momentum L of the whole system are defined as 
follows 

P« XmjVj (9) 

i-0 

L= ipA + miRiXVi] (10) 


2.1 Maninulatnr Dynamics 

The total kinetic energy of the space robot can be 
written as 

T-iifmiVTVi+nJlA) (20) 

Z i«0 

Using Equations (3) through (8) and (13) through (17) 
the kinetic energy can be expressed as 


Substituting Equations (2) through (8) into Equations 
(9) and (10) yields 

P«H v V B +H y0 fl B + H v ,q (11) 

L*Hj Q V B +H 0 n B + Ho,q + R B xP (12) 


where 


H v • m e Ij*j. H y € R 3 * 3 (13) 

Hyo*-tn e [r e x], H vQ €R 3 * 3 (14) 

Hvq * Xm^Li. H^eR 3 * 8 (15) 

i*l 

■j* 

Hq = i Ii + i mi [r* x] [rj x], H fl € R 3 * 3 (16) 

i*0 i«l 

Ho,« i{l i J Ai +m i [riX]J li }, H^eR 3 * 8 (17) 


For any vector f *[f, f 2 f 3 f , [fx] is defined as 
0 -f 3 f 2 


[fx], 


L-fs 


0 -f, 

U o 


Jh v 

H»n 

< 

'v.- 

Ab q T lH?o 

H c 

Ho, 

Ob 

[K 

Ho, 

■1 

or 

X 

. 9 . 


where Hq is the inertia matrix corresponding to the 
fixed base manipulator 

H, - iklliJii ^ + JIM*]. « R " X " (22) 

i-l l 

Equation (21) for the system kinetic energy can be 
simplified as follows. Substituting for Vg from 
Equation (18) leads to 

T«ifljMfl B + nJZq + |q T Wq (23) 

where 

M-Ho-HJqH^q, MeR 3 * 3 (24) 

ZeR 3 " (25) 

W « H, - , W € R n " (26) 


Since the working environment is non-gravitational 
and no actuators generating external forces are 
employed, the linear and angular momenta of the whole 
system are conserved. Since the inertial frame is fixed 
to the orbit, the entire system can be assumed to be 
stationary with respect to the inertial frame at the initial 
state. Thus the above two momenta are always zero for 
the system. Note that it is implicitly implied that the 
satellite is a non-spinning body. By using the fact that 
the linear and angular momenta are zero, Equations (1 1) 
and (12) result in 

Vj^-H^H^nB + H^q] (18) 


Further, substituting for fig f rom Equation (19), one 
obtains an expression for the system kinetic energy 
solely in terms of the joint variables. 

T = |q T D(q)q. DoR 8 * 8 (27 ) 

where D is the inertia matrix of the system and is given 
by 

D = W - Z t M _1 Z . (28) 

It can be shown that D * D T > 0. It is interesting to 
note that the system inertia matrix obtained in 
Reference [1] is of the same form as above. However, 
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the expressions for W, M, and Z matrices are different. 
This is because a different approach, viz., the concept of 
barycenters, is used in the model derivation of 
Reference [1]. It is also noteworthy that the inertia 
matrix obtained above requires only a 3 x 3 matrix 
inversion, while that obtained by Masutani, Miyazaki, 
and Arimoto® requires a 6 x 6 matrix inversion. 

Since there is no potential energy in non- 
gravitational environment, ihe Lagrangian A, is equal to 
the kinetic energy * 


A = T (29) 

So the system dynamics is given by 



where t is the n x 1 vector of joint torques. The 
equation of motion for space manipulators is then 
obtained by using Equation (30). 

D(q)q + h(q,q) = x (31) 

where 

h(q.q)*C(q,q)q + T, (32) 


Paralleling the development for fixed base robots given 
by Spong and Vidyasagar 7 , the elements of the matrix 
C are obtained as 


c* 


^ £ aP kj { dDt, 
2 i«i _ 3qj dq j 



(33) 


matrix consisting of viscous friction coefficients for the 
manipulator joints. The vector sgn{q} is defined in a 
component-wise sense. It turns out that in many 
manipulator joints, friction also displays a dependence 
on joint position. However, such effects are not 
considered here. There are other effects like bending 
effects that are difficult to model and also neglected in 
the present model. 


Joint 

Friction 

Torque Viscous 



Fig. 2. Joint Friction Model Consisting of Coulomb’s 
Friction and Linear Viscous Friction. 

2.4 Base Motion 

The translational velocity of the base center of 
mass can be written in terms of joint velocities by using 
the expression for flfi from Equation (19) in Equation 
(18). 


tf represents the joint torque vector due to friction. As 
pointed out by Qaig*, the total friction at each joint can 
be regarded as the sum of Coulomb friction and viscous 
friction. Coulomb friction is constant except for a sign 
dependence on the joint velocity. Viscous friction, in 
general, depends on various powers of joint velocity. 
However, higher powers contribute significantly only at 
high joint velocities. Manipulators usually do not attain 
such high velocities. Therefore, it is sufficient to 
consider only the linear dependence of viscous friction 
on joint velocity. Figure 2 shows a friction model 
consisting of Coulomb friction and linear viscous 
friction. Using this model, the joint friction torque 
vector can be represented as 

t f «Xsgn{q} + Tq (34) 

where X is a diagonal matrix consisting of Coulomb 
friction constants for the joints, and T is a diagonal 


V B «-H; , [H w ,-H vQ M- , Z]q (35) 

Also, the base angular velocity from Equation (19) is 

fi B • -M _, Zq (36) 

Using the above expressions, the evolution of the base 
position and orientation with time can be determined. 


3. Control System Design 

Assuming that the dynamics of the space 
manipulator is described by Equation (31), where D and 
h are completely known, the feedback linearization or 
inverse dynamics 7 technique can be used to design 
controllers for tracking prescribed command trajectories 
for the joint angles. This can be accomplished as 
outlined in the following sub-section. 
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3.1 Feedback Linearization 

Let the joint torque vector be of the following 
form. 


3.2 Robust Feedback Linearization Using Passivity 
In the presence of modeling uncertainties, let the 
control law be given as 


t = Du + h (37) 


t«£>u + h + w 


(42) 


where u is the pseudo-control, i.e., it is the control input 
to the resulting linearized system. With the control law 
given by Equation (37), the closed-loop system 
becomes 


where 



(38) 


(39) 


where D and h are computed versions of D and h, 
respectively. The additional feedback w(t) has been 
introduced to compensate for the modeling 
uncertainties. Substituting for t and u from Equations 
(42) and (40) into Equation (31) it can be shown that 
the closed-loop system dynamics is given by 

e= A e e+Bv (43) 


where 


v = Au + 6 (44) 


A simple PD (Proportional-Derivative) type of control 
law is chosen for the feedback linearized system 

u = q d +K 2 (q d -q) + K,(q d -q) (40) 

where Ki and K 2 are proportional and derivative gain 
matrices, respectively. These matrices are usually 
chosen to be diagonal in order to achieve decoupled 
response among the joint angles. Substituting for u 
from Equation (40) into Equation (38), one obtains 


and 

A = [i-D-‘d], 8 = D _1 [h-h-w] (45) 

The first step in the proposed design is to choose 
die gain matrix K *= [K, K 2 ] and an output matrix F 
such that the linear system given by 

4= A t e+Bv 


e = A e e (41) 

where e*[e7 eJ] T .e, «q d -q, e 2 *q d -q, 

A e *A-BK,and K = [K, K 2 ]. IfKi>0andK 2 > 
0, the error dynamics as given by Equation (41) is 
asymptotically stable. The freedom in selecting the 
gain matrices can be utilized to meet performance 
specifications for the closed-loop system. 

The preceding discussion assumes availability of 
perfect knowledge about the nonlinear system 
dynamics. However, in practice, D and h are usually 
imprecisely known due to modeling inaccuracies. For 
instance, the controller would be designed using the 
best estimates for friction coefficients. The actual joint 
-friction might be different from that which is assumed 
'for the controller design. Thus the controller uses 
computed versions of D and h. The objective here is to 
design a control law that is robust for bounded 
variations in D and h due to bounded uncertain dynamic 
effects. This issue erf robust control design is discussed 
in the following sub-section, where it will be seen that 
the control law results in closed-loop asymptotic 
tracking. 


is SPR (Strictly Positive Real). This can be achieved as 
outlined in the following Theorem. A definition of the 
concept of Strictly Positive Realness can be found in 
Slotine and Li 9 . 

Theorem 1 (10). Let Kj and K 2 be such that 

Kj =diag[k,,]; k H >0, i = l,...,n 

K 2 « diag[k 2i ]; k 2i > 0, i = 1 n (47) 

(k 2i ) ^k]j, t»l,...,n 

then if F ■ K, the system described by Equation (46) is 
SPR. 

Note that the conditions of the Theorem as prescribed 
by (47) are extremely easy to satisfy. 

With the linear System (46) being SPR, the 
Passivity -Theorem 11 can be used to design 
asymptotically stable controllers as shown in the 
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following Theorem. The notation 
is used in the sequel. 



Theorem 2- Suppose that 

(a) The desired trajectory for joint variables is such 
that q d c L 2 . 

(b) Finite and P 2 exist such that the uncertainty in 
h is bounded as follows. 


Ih-h^S P,|u| T + p 2 (p,*0. p 2 3i0)VT*0 (48) 


v = Au + 8 

* [i - D* 1 £>]u + D" 1 [h - h - w] 

= D _1 x-D _1 w (52) 

where x ■ [d - f)|u + h - h . Substituting for v from 
Equation (52) into Equation (51), the integral becomes 

I = u T D _, xdt j+ ^ J u T D _1 wdt j (53) 


(c) The additional feedback w(t) in the control law of 
Equation (42) is of the following form. 


Let the first and second integrals on the right hand side 
be denoted by Ij and I 2 respectively. Then 


w(t) = au(t) (akO) (49) 

Under these conditions, if a is chosen such that 


a> 



(50) 


where 

X*X mix (D); then 

the closed-loop System (43) is asymptotically stable. 

Proof. The closed-loop system as given by 
Equation (43) can be represented in block diagram form 
as shown in Figure 3. It is first shown that the 
nonlinear block in the feedback path is passive 1 


SPR 



Fig. 3. Robust Feedback Linearization Using 
Passivity Theorem. 


Consider 


I = -]u T vdt (T*0) (51) 

0 

From Equation (44), v is given as follows. 


-Ii = /u T D _1 xdt 
0 

*I u ItI d H (Holder' s Inequality) (54) 


Note that 

|d -1 x£ = jx T D‘ T D' 1 xdt 

SX^D^D-’jVxdt X55) 
0 

and * 

(D- T D- ) - oL.(D-' ) - ^ (56) 

Substituting for X b , x (D' t D - 1 ) from (56) into 

Inequality (55) and then taking the square root of both 
sides, one gets 

(S’) 

Using Inequality (57) in (54), 

(58) 

c \ 

Recalling that x*|D-£>Ju + h-h, and using 
Schwarz's Inequality, 

J x !I t s|d-d]u[^ +| h -h| r (59) 


1014 




(68) 


Since 

|d - dJu^ S O^Jd - £>)]u||t = o 2 |u|| T , (60) 

then Inequality (59) can be expressed using Inequalities 
(48) and (60) as 

Ixl^fo+pjulr+p, (61) 



Thus a sufficient condition for the nonlinear block to be 
passive is that o > j. 


Finally, using Inequality (61) in Inequality (58), a lower 
bound for Ii is obtained in the following form. 

IiSS—^ + PiNt + PsIuIt] («) 

Now consider 
T 

I 2 = ju T D -I wdt 


= o/u T D _1 udt 
0 


^ o^-min ID” 1 ) J U T U dt 


(63) 


Noting that 


U D )^’ 

an upper bound for I 2 is obtained as follows. 


( 64 ) 




(65) 


Thus, using Inequalities (62) and (65) in Equation (53), 

I*(f - £2 ^ L )Nt - fj'I u * T “ f (l u ® T ) (66) 

It can be shown that if I i n. |> 0 , then 






g Q 2 +Pi 
~ h j 


( 67 ) 


which in turn would imply 


Additionally, it is observed that the transfer 
function of the feedforward block [Ac, B, K] is proper 
and has no poles on the imaginary axis. Hence it has 
finite gain 1 2 Since according to Assumption (a) of the 
Theorem q d e L 2 , then using the Passivity Theorem 11 , 
one can conclude that the signals u, Ke, and v are 
bounded. Moreover, since the feedforward block is 
SPR, Ke(t) ■ Kiej(t) + K 2 e 2 (t) goes to zero 
asymptotically. This in turn implies that e^t) and e 2 (t) 
individually approach zero asymptotically 8 . 


Remarks. 

(i) Some of the methods proposed in the past for 
designing robust controllers for robotics problems result 
in introduction of chattering in the control 7 . When the 
design method is modified to make the control smooth, 
closed-loop asymptotic tracking is generally 
compromised to some extent. In the control design 
proposed by Theorem 2, the achievement of robustness 
can be qualitatively understood as follows. The control 
law given by Equation (42) compensates for the 
uncertainty due to unknown D and h by employing 
additional feedback w. If the choice of w satisfies the 
assumptions of the Theorem, asymptotic stability for 
the joint error states is achieved. 

(ii) The results of the Theorem are applicable to space 
manipulators as well as fixed base manipulators. 
Finally, it should be noted that the control design 
suggested using the results of the Theorem is not 
unique. First of atl, w(t) need not be restricted to be of 
the form given by Equation (49) and second, even 
within the scope of the suggested design, there is a 
considerable amount of margin for performance 
optimization. 


4. Simulation Ecsults 

The results of applying Theorems 1 and 2 in order 
to achieve a robust control design are illustrated for a 
planar single link space manipulator. Figure 4 shows 
such a planar one link space robot. A nonlinear 
dynamic model for the robot is obtained using the 
results of Section 2. Equation (31) describes the 
dynamics of this one degree of freedom system. The 
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system inertia, computed using Equation (28), turns out 
to be 

JXqi>«W I 4 -Zk/M M (69) 

where 


y* ! 


m 

m 

m 


* L 


Pj s iri “ (Po s «r + Pi s vi) 


3,3 




m. 


2 

' I ’ lC v , + M ii "( PoC * +PlC vi) 9l 

m 3.3 


(75) 


W 14 * rnoiPi + Ij (70) 

Z 34 * m oiPi(po c i + Pi ) + Ii (71) 

M 3 3 e m 0 , (pq + p? + 2p 0 P]C] ) + 1 0 + Ij (72) 


where s v i ■ sin(v + q! ), c ¥ , • cos(y + q, ) . Finally, 

the base attitude dynamics is obtained using Equation 
(36): 






x 


I 


V 



(76) 


Assuming that no modeling uncertainty exists, a 
feedback linearizing controller is designed for the one 
link space manipulator using the control law given by 
Equation (37). Simulation is carried out using 
automatic step size second and third order Runge- 
Kutta-Fehlberg integration methods 13 . Table I lists 
physical parameters of the example robot used in the 
simulation. Note that the base and link masses are 
assumed to be of the same order of magnitude. The 
values of Coulomb and viscous friction coefficients are 
taken to be 

X = 0.5 N-m, y = 2.0 N-m-s/rad (77) 

Closed-loop results are generated for a step command 
of 1 radian to the joint angle. The feedback gains are 
chosen to be kj « 0.4 and k 2 » 1.0. This choice of 
gains satisfies Conditions (47) and yields a closed-loop 
response without any overshoot, as shown in Figure 5. 


Fig. 4. A Single Link Planar Space Robot 
Using Equations (32) through (34), h is found to be 

1 *(qi»9i)““^rj^^'[ m 0 iP 0 (Po + Pi c i) + lo3' 

M 3.3 (73) 

( m oiPi (P0C1 + Pi ) + Ii ]q? + XsP»(qj ) + Wi 

where x and y are respectively the coefficients of 
Coulomb and viscous friction. In Equations (70) 
through (73) m 0l ■ m 0 mi /m c , m c «m 0 -(-m,, 
Cj ■ cos(qj ) , and s, ■ sin(q t ) . 

- It can be seen easily that as m 0 -»« and I 0 — > <», 
D-Mttipf + I,. h-*XSgn(q,)+rii (74) 


Table I. Physical Parameters of Single Link Planar 
Space Robot 


Body 

p (meter) 

1 (meter) 

m (kg) 

I (kg.m 2 ) 

0(Base) 

3.0 

- 

5.0 

30.0 

1 (Link) 

3.0 

6.0 

1.0 

3.0 


Next it is assumed that the value of the Coulomb 
friction coefficient % is unknown, but that 


0.5<IX£0.75 (78) 

Since uncertainty exists in the h vector, the computed 
version of h is given by 


which represents the case of a fixed base manipulator. 
Equation (35) is used to determine the evolution of the 
base position with time 


where X s 0-5. which is the nominal value of the 
Coulomb friction coefficient. The response of the 
controller with x “ 0.75 and without any additional 
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feedback is shown in Figure 6. It can be seen that there 
is a steady-state error in the joint angle response. The 
steady-state error in this particular instance can be 
eliminated by adding an integral feedback term to the 
control law given by Equation (40); however, this is 
accompanied by a large overshoot Hence, a need 
exists for making the control law robust with respect to 
the uncertainty. The results of Theorem 2 are used for 
the design. It is first noted that 


stable, this implies that Inequality (48) must have been 
violated. The amount by which violation occurs is used 
as a measure to update the estimates of Pi and p 2 . The 
process is repeated until convergence is obtained. For 
die present example, it was found that Pi ■ 12.5 and P 2 
m i .5 satisfy Inequality (48). This resulted in a choice 
of o * 25.0 for the design. Note that the process 
implicitly assumes at the outset that condition (b) of 
Theorem 2 will hold. 


|h-h| T =|(x-xM<ii)l r 

-jx-X^[sgn(qi)fdtj 


(80) 



Fig. 5. Joint Angle Response With No Modeling 
Uncertainty. 

Clearly, |h-h| T is maximum when jx-x| is 

maximum. Hence the controller is designed for x “ 
0.75, and it works for all other values of % lying in the 
range indicated by (78). The design involves 
determining a suitable value of a that satisfies 
Inequality (50), assuming that finite Pi and P 2 exist for 
the bound given by Inequality (48). Figure 7 shows the 
variation of system inertia, D, given by Equation (69), 
with respect to the joint angle. From this plot, it is 
easily found that X • 10.2273, and ©i « 5.3571. 
Clearly, by definition, 02 - 0. Hence the requirement 
(50) of Theorem 2 translates to: 



Fig. 6. Joint Angle Response With Bounded 
Uncertainty in Friction Modeling. 



Fig. 7. Variation of System Inertia Matrix With the 
Joint Angle. 


a>1.91(P,) (81) 

The values of Pi and P 2 are obtained in an iterative 
manner. Starting with an assumed set of values for 
these parameters, closed-loop simulation is performed 
with the resulting value of a as obtained by Condition 
(81). If the joint error states are not asymptotically 


Figures 6 and Figures 8 through 12 show the 
closed-loop responses for the design, with and without 
the inclusion of additional feedback. Figure 6 shows 
that asymptotic tracking in the joint angle is achieved in 
the face of uncertainty. Figures 9 and 10 show that the 
base moves in reaction to link motion; this is due to the 
conservation of linear and angular momenta as 
discussed in Section 2. Figure 1 1 depicts the 
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Fig. 


8. Joint Velocity Response With Bounded 
Uncertainty in Friction Modeling. 



Fig. 11. The Quantity Pj|uJ T + p 2 “| h- ^| T 

Bounded Uncertainty in Friction Modeling. 
.’.Robust Control, -:Nominal Control 


I 


•1 



5 10 15 

Time (seconds) 


Fig. 9. Base Attitude Response With Bounded 
Uncertainty in Friction Modeling. 



Fig. 10. Base Position Response With Bounded 
Uncertainty in Friction Modeling. 


Fig. 12. Joint Torque Input With Bounded 
Uncertainty in Friction Modeling. 

satisfaction of Inequality (48). Figure 12 shows the 
joint torque input requirements. It was confirmed 
through simulations that the controller designed works 
well for any value of % within the range indicated by 
(78). Indeed for any value of % < 0.75, the uncertainty 
bound on h is satisfied by a greater margin. 


5. Conclusions 

A nonlinear dynamic model was obtained for space 
manipulators with uncontrolled base. A robust control 
method based on feedback linearization and passivity 
concepts was proposed for space manipulators. The 
method is applicable to fixed base manipulators as well. 
The control law results in asymptotic joint angle 
tracking in the face of bounded uncertainties such as 
those due to imprecise friction modeling. 
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